#include <iostream>
#include "toolbox.h"
#include "FQuaternions.h"
#include <variant>
using namespace Math;

int main(int argc, char **argv)
{
    // 3DMath function test

    float v1 = (226) / 180.0f * PI;
    float v1warp = MathUtil::warpPi(v1);

    float angle = v1 * 180.0f / PI;
    float angle1Warp = v1warp * 180.0f / PI;

    std::cout << "v1: " << v1 << "\t v1warp: " << v1warp << '\n';
    std::cout << "v1: " << angle << "\t v1warp: " << angle1Warp << '\n';

    FQuaternions q1(1, 1, 2, 3);
    FQuaternions q2(2, 1, 2, 3);
    auto result = q1 * q2;
    std::cout << "q : " << result.x;

    std::variant<char,int> set;
    
}